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Изложены методы планирования и расчёта траектории движения сверхлёп кого летательного аппарата при 
проведении авиахимических работ. Предложены методы коррекции и преобразования координат, получае- 
МЫХ СО спутниковой навигационной сист. емы, и упреждающего сглаживания для исключения влияния инерт- 
ности системы «пилот — летательный аппарат». 
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Введение. В настоящее время при химической обработке полей всё чаще используется малая 
авиация, что обусловлено высокой скоростью проведения работ, их большими объёмами, низкой 
стоимостью гектара обработанной площади. Однако проведение авиахимической обработки по- 
лей является сложным и зачастую опасным видом работ, требующим применения специальных 
систем контроля и регулирования, которые должны обеспечивать параллельное вождение лета- 
тельного аппарата с требуемой точностью при внесении химических веществ, с учётом бокового 
ветра и корректировкой траектории для достижения наилучшего результата [1]. Существующие 
системы параллельного вождения ориентированы на наземную технику, и применение их в авиа- 
ции ограниченно. В данной статье авторами предлагается опорно-эквидистантный метод коррек- 
тировки траектории движения летательного аппарата, позволяющий формировать направление 
движения на основе задания опорной и последовательного построения эквидистантных ей траек- 
торий по четырём точкам. 

Основой для планирования и корректирования является спутниковая навигационная сис- 
тема ГЛОНАСС/СР5. Очевидным является тот факт, что используемая в данных системах геоста- 
ционарная система координат не подходит для реализации требуемой задачи, т. к. обладает из- 
лишней информативностью и существенно усложняет вычислительные операции [2]. Также имеет 
место ряд специфических особенностей систем навигации, которые могут значительно ухудшить 
результаты расчёта либо сделать их некорректными. 

При расчёте траектории полёта необходимо учитывать инерцию летательного аппарата и 

время реакции пилота — в противном случае возможно возникновение автоколебаний системы 
«пилот — машина», также приводящих к ухудшению результата. Предлагаемый алгоритм учиты- 
вает все вышеописанные особенности управления воздушным судном при проведении авиахими- 
ческих работ, что позволит уменьшить погрешности обработки, существенно снизить потери уро- 
жая, а также наносимый окружающей среде вред. 
Метод упрощённого преобразования координат. Для измерений необходимо определить 
систему координат, в которой будут проводиться расчёты. Наиболее целесообразно использовать 
декартову систему координат с началом в первой полученной точке обрабатываемого поля, а ко- 
ординатами следующих точек считать их отклонения от нового начала. Далее необходимо произ- 
вести преобразование размерностей полученных точек из геоцентрической системы координат в 
метрическую систему: 


Уно = Уи 1849.1, Хз = Хи 40075695,3. с0$(у„,)/360, 
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Где Хи, Хы, Ум, Ум — абсциссы и ординаты точки в метрической и геоцентрической системах 
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координат. 
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Рис. 1. Преобразование системы координат 


Основными параметрами траектории первого гона являются начальная О, (х,,у,) и ко- 
нечная О, (х„‚у,„) точки. Начало координат в новой связанной системе отождествляется с первой 
сохранённой точкой О, (х,‚у,), при этом ось абсцисс направляется вдоль линии, соединяющей 


первую и последнюю точку, а ось ординат — ортогонально к ней в направлении формирования 
правой системы координат (рис. 1). 

Уравнение прямой, проходящей через указанные точки Р (х,,у,} и Р, (х„,У, ), запишем в 
виде (у. -у,)х+(х,-х,)у + (ху, -х,У,)=0. Так как первая точка является началом коорди- 
нат, то коэффициенты в уравнении прямой Ах+Ву+С, =0 будут следующие: 
А =-У„, В, =Х„, С, =0. Эта прямая является осью абсцисс системы координат Х„О„У, . Так как 


ось ординат расположена ортогонально, то отклонения точек от прямой РР, являются их орди- 


натами. Расстояние от точки Р, рей у до оси Х„, вычисляется следующим образом: 


(т) _ Ах» + ВУ» + С, 





или при С, =0 


(т) — Ах” + ВУ „ 
НОВ А + В? 


Абсцисса х“”) рассматривается как расстояние между началом координат и перпендику- 


НОВ 


ляром, опущенным из точки на прямую РР, ‚ и составляет 
(т) |2 _ („т 
Хнов = 9%-—{у) ' 


где а» — расстояние РР,. 
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Знак отклонения определяется по знаку угла между прямыми РР,: Ах+Ву +С, =0 и 
РР,: Ах +В,у +С, = 0, в соответствии с уравнением: 
АВ, - АВ, , 
АА, + ВВ, 


Для того чтобы определить знак отклонения, необходимо сравнить знаки полученного уг- 





а = ага 


ла и у") . Если эти знаки совпадают, то абсцисса в новой системе координат положительна, в 


нов 
противном случае — отрицательна. 

Корректировка координат навигационной системы. Одной из особенностей современных 
систем позиционирования является наличие так называемых «скачков позиции» вследствие 
влияния различных помех, в том числе ионосферных искажений, эффекта многолучевого распро- 
странения и др. Как показали исследования, при статическом позиционировании разброс 
значений достигает 2—5 метров. При проведении авиахимических работ скачки координат могут 
внести существенную погрешность в измерения текущего положения техники и привести к значи- 
тельному ухудшению качества выполняемых работ. Однако данные скачки координат можно кор- 
ректировать. Предлагается метод корректировки, основанный на измерении ускорения движения 
летательного аппарата. Частота поступающих данных с навигационной системы равна 5 Гц, сле- 
довательно, время Т, между расчётами не превышает 0,2 с. В этом случае ускорение =, разви- 


ваемое техникой на данном интервале времени, составляет = = (И, - И)„) 5, где И», И, — скоро- 
сти, измеренные на предыдущей и текущей итерациях соответственно. 

При авиахимических работах требуется максимально линейное движение летательного 
аппарата с постоянной скоростью. При возникновении скачка расчётное ускорение может иметь 
значительную величину (рис. 2, точка Р,). При движении техники с навигационной системы по- 


ступают сигналы о рассчитанном текущем 

местоположении летательного аппарата 
А, (№, 9), (№, У), (№, У), (№, 3). В каждый 
момент времени позиционирования текущая 
скорость движения техники в Ай точке рав- 
на 


и хх +и и, 





В(Х,.) 





Р;(Х;,:) где /= 1,2, 3, 4 — номер точки. 

Для обнаружения ошибки позицио- 
РА. С нирования, т.е. выявления фактического 
Ра скачка, следует при каждом новом поступ- 
лении координат с навигационной системы 
производить расчёт ускорения и проверять 
В (Х»,',) условие =, <Е где =, — текущее значе- 


доп ! 
ние ускорения техники, & доп — допустимое 


ускорение техники. При невыполнении этого 
условия необходимо корректировать рас- 
чётное местоположение. Для этого полага- 
ем, что движение происходило в том же на- 
правлении и с той же скоростью, тогда от- 
Рис. 2. Схема движения техники клонения по координатам для рассматри- 
ваемого случая составляют 0, =Х, -Х, , 


В (Х, 
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0, =У-У . В этом случае координаты истинного положения точки Р; (х; и) равны 
Х; =Х, +0, , У; =У, +0, , а величина ошибки позиционирования по координатам составит 
Деу 


Общая ошибка позиционирования по координатам определяется суммой текущей и пре- 
дыдущей ошибок 0„,0,: 0, =0„+Д,, 0, =д, +Д, . При расчёте текущего местоположения на 


последующих итерациях в случае отсутствия скачка координаты текущего местоположения кор- 
ректируются на величину общей ошибки позиционирования Х; =Х, +0,, У; =У, +0,. Если же 


обнаружен скачок, то необходимо производить коррекцию, описанную выше. 
Планирование траектории движения. В результате записи первого гона и проведения преоб- 


азования координат формируется массив точек Р. (х"), у"), который является основой для 
т НОВ 


НОВ 


опорно-эквидистантного метода планирования направления движения летательного аппарата. 
Учитывая, что расположение точек имеет неравномерный дискретный характер, для обеспечения 
расчёта требуемой траектории движения в реальном времени необходимо производить интерпо- 
ляцию данных методом наименьших квадратов Гаусса. Использование этого метода интерполяции 
связано с определёнными ограничениями. Ввиду нелинейности характера траектории движения 
летательного аппарата, а также из-за погрешностей позиционирования навигационной системы 
применять интерполяцию по всем данным нецелесообразно. Интерполяционная кривая, постро- 
енная по всем точкам траектории, требует значительных вычислительных мощностей и не подхо- 
дит для применения в малых микропроцессорных системах. 

Поэтому при расчёте требуемой траектории движения предлагается использовать 4 бли- 


жайшие точки из массива точек первого гона Р, ту} ‚ при этом внутренние две точки ис- 


НОВ 


пользуются непосредственно для расчёта отклонения, а внешние — для задания характера ин- 
терполяционной кривой (рис. 3). 


Требуемая траектория движения 






Первый гон 


Рей 






Рис. 3. Расчёт требуемой траектории по рабочим точкам 


Для определения интервала последовательно просматриваются все точки массива, и если 
значение абсциссы находится в пределах точек Р.Р, , тогда этот интервал принимается за иско- 
мый. После определения рабочего интервала берутся крайние точки интервала РР, , а также 
точка Р,, и точка Р.., , если таковые имеются. В случае отсутствия Р., и Р., 
Р.. иР › соответственно. Далее в процессе движения летательного аппарата рассматриваются 
только лишь шесть точек массива — выбранные ближайшие четыре (рабочие точки), а также сле- 
дующая за ними, и предшествующая им (вероятные точки), если таковые имеются. В каждый мо- 


Используются точки 
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мент времени рассчитывается расстояние от текущей ординаты до всех точек, и если определяет- 
ся, что расстояние до какой-либо вероятной точки меньше расстояния до рабочей точки, то про- 
исходит смещение основных точек в её сторону. 

Для того чтобы максимально упростить деятельность эксплуатанта сельскохозяйственной 
техники и систематизировать значения координат обработанных участков, целесообразно опре- 
делять сторону обработки (гон слева или справа). 

Так как число рабочих точек равно четырём, то интерполяционная кривая представляет 
собой кубический сплайн. При расчёте отклонения необходимо рассчитать расстояние от интер- 


поляционной кривой до текущей точки: @, =у, -Ё(х,), где у, — ордината текущей точки Р,, 
2%.) — интерполяционная кривая, построенная по четырём рабочим точкам для точки Р. 


Найденное расстояние 4, представляет собой текущее отклонение летательного аппарата 
от первоначальной траектории движения. Для нахождения полосы обработки и отклонения от 
неё вычисляется число полуполос п„ для задания ширины захвата /, которые содержит в себе 


отклонение: п„ =2а,//. Необходимость расчёта не полос, а полуполос обусловлена тем, что от- 


счёт ведётся от середины захвата, а не от его начала. Далее определяется номер полосы, по ко- 
торой происходит движение в текущий момент времени: п, =0,5 (п. +1) . После определения 


номера текущего гона (полосы обработки) рассчитывается ошибка отклонения движения техники: 
би =@-/-П,. 

Полученное отклонение может служить основой корректировки курса летательного аппа- 
рата при проведении авиахимических работ. Однако, ввиду высокой скорости перемещения лета- 
тельного аппарата, его инертности, времени реакции пилота, а также дискретности поступающих 
данных, вождение по текущему отклонению может усложнить пилотирование и привести к коле- 
бательному процессу обработки полей. В связи с этим предпочтительным является прогнозирова- 
ние положения летательного аппарата на основе истории его движения, т. е. выполнение кор- 
рекции на основе экстраполяции траектории его движения. Для расчёта будущего положения ис- 
пользуются координаты трёх предыдущих точек движения, по которым методом численной ин- 
терполяции строится парабола движения. После этого выполняется экстраполяция функции с ша- 


гом равным, среднему шагу используемых точек: х„„ =х, +(х, -х,)/2, И на 
где х,,х›,х, — абсциссы используемых точек движения; # (Хож — интерполяционная кривая, 


построенная по этим точкам. 
Выводы. Авторами предложен алгоритм автоматического планирования и корректировки траек- 
тории полёта летательных аппаратов при авиахимической обработке полей. Особенностями дан- 
ного алгоритма являются ориентированность на сверхлёгкие летательные аппараты, учёт влия- 
ния бокового ветра на величину и снос рабочей полосы обработки поля. Отличительной чертой 
предложенного алгоритма также является использование алгоритмов сглаживания, ориентиро- 
ванных на устранение колебательности при корректировке отклонения от требуемой траектории 
движения, вызванной инертностью летательного аппарата и задержками в реакции пилота. При- 
менение предложенного алгоритма на практике позволит существенно повысить качество хими- 
ческой обработки полей путём исключения грубых ошибок обработки, а также уменьшить вред- 
ное влияние на окружающую среду. 
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